#include "gec_gpio.h"

void carInit() {
  Gec_GPIO_Init(GPIOA, GPIO_Pin_4, GPIO_MODE_OUT_PP);
  Gec_GPIO_Init(GPIOB, GPIO_Pin_7, GPIO_MODE_OUT_PP);
  Gec_GPIO_Init(GPIOD, GPIO_Pin_6, GPIO_MODE_OUT_PP);
  Gec_GPIO_Init(GPIOD, GPIO_Pin_7, GPIO_MODE_OUT_PP);
}
void leftWheelRun() {
  PAout(4) = 0;
  PBout(7) = 0;
  PDout(6) = 0;
  PDout(7) = 1;
}

void leftWheelBack() {
  PAout(4) = 0;
  PBout(7) = 0;
  PDout(6) = 1;
  PDout(7) = 0;
}

void rightWheelRun() {
  PAout(4) = 0;
  PBout(7) = 1;
  PDout(6) = 0;
  PDout(7) = 0;
}

void rightWheelBack() {
  PAout(4) = 1;
  PBout(7) = 0;
  PDout(6) = 0;
  PDout(7) = 0;
}

void carStop() {
  PAout(4) = 0;
  PBout(7) = 0;
  PDout(6) = 0;
  PDout(7) = 0;
}

void carGoForward() {
  PAout(4) = 0;
  PBout(7) = 1;

  PDout(6) = 0;
  PDout(7) = 1;
}

void carTurnLeft() {
  PAout(4) = 0;
  PBout(7) = 1;

  PDout(6) = 1;
  PDout(7) = 0;
}
void carTurnRight() {
  PAout(4) = 1;
  PBout(7) = 0;

  PDout(6) = 0;
  PDout(7) = 1;
}
void carGoBack() {
  PAout(4) = 1;
  PBout(7) = 0;

  PDout(6) = 1;
  PDout(7) = 0;
}


